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25 SPECIFICATION 
1. TITLE OF THE INVENTION 

TUNING DEVICE FOR ROBOT CONTROL SYSTEM 
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2 . SCOPE OF PATENT CLAIM 

(1) A tuning device for a robot control system in which 
a robot arm is caused to operate via a torque transmission 
mechani sm while driving an actuator to a target value input 

5 to a control device body comprising: 

an external sensor which detects an actual operation 
of the robot arm from an external side; 

a compensation signal preparing unit which prepares 
a compensation signal for changing a target value so that 
10 the robot arm operates in accordance with the target value 
toward the target value input to the control device body 
while identi f ying a dynamic characteristic model concerned 
with an operation mechanism composed of the actuator, the 
torque transmission mechanism, and the robot arm using a 
15 detection signal of the sensor; and 

a target value changing unit which changes the target 
value input to the control device body with the compensation 
signal prepared by the device. 

(2) A tuning device for a robot control system in which 
2 0 a robot arm with relatively low rigidity is caused to operate 

while driving an actuator toatarget value input to a control 
device body comprising: 

an external sensor which detects overshoot amount 
at a direction changing point in a reciprocating motion 
25 of the robot arm from an external side; 

a control constant which sets unit setting a control 
constant of a PID control system which forms the control 
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device body while identifying a dynamic characteristic 
model of the robot arm; and 

a control constant fine adjusting unit which fine 
adjusts the control constant set by the control constant 
5 setting unit so that the overshoot amount falls within a 
prescribed value using a detection signal of the external 
sensor when the robot arm is caused to perform a 
reciprocating motion using a control constant set with the 
device . 

10 (3) The tuning device for the robot control system 

according to claims (1) and (2), wherein the signal for 
identification, which signal is input to the actuator, is 
an M sequence signal to which DC bias is added. 
(4) The tuning device for the robot control system 

15 according to claim (2), wherein the control constant 

setting unit sets the control constant of a speed control 
loop upon obtaining an open-loop frequency character i stic 
data and a closed loop frequency characteristic data of 
a speed loop using the frequency characteristic data, and 

20 subsequently, sets the control constant of a position loop 
upon obtaining an open-loop frequency characteristic data 
and a closed loop frequency characteristic data of the 
position loop while using the- closed loop frequency 
characteristic data of the speed loop. 

25 3. Detailed Description of the Invention 
[Object of the Invention] 
( Industrial Applicability) 
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The present invention relates to a tuning device for 
a robot control system in which a robot arm is caused to 
operate to a target value input while driving an actuator. 

(Prior Art) 

5 Generally, a joint structure of a robot is in a state 

shown in, for example, Fig. 26. 

That is, there is connected a robot arm 4 via a torque 
transmission mechanism 3 such as a speed reducer or the 
like, to an actuator 2 such as motors with an actuator sensor 
10 lsuchas angle sensors , whereby a control signal u is output 
to the actuator 2 from the control device body 5 such as 
a PID control device or the like, such that a signal 0 m 
detected by the sensor 1 becomes equal to a target value 

15 Here, conventionally, since a motor angle 0 m is equal 

to an arm angle 9 e in the case that rigidity of the torque 
transmission mechani sm 3 is sufficiently high, a motor 
target value 0 mt is set as an arm target value 6 er - 

On the other hand, although the completed robot should 
20 be set, for instance, a predetermined PID control constant 
in its PID control device by a so-called tuning work, 
conventionally, this work has been performed manually. 

That is, the conventional tuning work is that 
appropriate control constant is set upon varying the PID 
2 5 control constant by trial and error while observing an 
actual operation of the robot . 

(Problems to be solved by the Invention) 



4 



However, in the conventional manual tuning work, the 
PID constants of the PID control device are changed 
variously while observing the actual operation, therefore, 
there are problems that much labor and time are required 
5 in its work and tuning result is not necessarily good. 
Further, since this work requires skill along with much 
labor and time, it is not possible to tune according to 
secular change or depending on a load change of the arm 
fingers, timely as needed. 

10 For that reason, conventionally, one so called as 

an adaptor is proposed in which dynamic characteristic is 
identified depending on a signal input to the actuator 2 
and an output of the actuator 2, at the same time, the PID 
control constant is supplied to the control device body, 

15 however, there is inconvenience that the adaptor cannot 
come in practice in that vibrations take place on the robot 
arm 4 caused by backlash of the torque transmission 
mechanism 3 or low rigidity of the arm 4, as well as 
sufficient algorithm is not established. 

20 By the way, as shown in Fig. 27, the actual operation 

0 e of the arm 4 deviates considerably large and randomly 
to the target value 0mr (Qer) caused by the backlash of the 
torque transmission mechanism 3 or the low rigidity of the 
arm 4 . 

25 Accordingly, in a tuning device for a robot control 

system where a robot arm is caused to operate while driving 
an actuator to an input target value, it is an object of 
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the present invention to provide a tuning device for a robot 
control system capable of tuning such that the robot arm 
can be subjected to positioning control in low vibration 
with high accuracy. 
5 [Constitution of the Invention] 

(Means for solving the problem) 

In order to solve the above mentioned problem, a tuning 
device for a robot control system of the present invention, 
as shown an outline in Fig. 1, in the tuning device for 

10 the robot control system where the robot arm 4 is caused 
to operate via a torque transmission mechanism 3 while 
driving an actuator 2 to a target value input to a control 
device body 5, the tuning device for the robot control system 
is characterized in that an external sensor 6 is provided, 

15 which detects an actual operation of the robot arm 4 from 
an external side; a compensation signal preparing unit 7 
is provided, which prepares a compensation signal for 
changing a target value so that the robot arm 4 operates 
according to the target val.ue in relation to the target 

20 value input to the control device body 5 while identifying 
a dynamic characteristic model concerned with an operation 
mechanism composed of the actuator 2, the torque 
transmission mechanism 3, and the robot arm 4 using a 
detection signal of the sensor 6; and a target value changing 

25 unit 8 is provided, which changes the target value input 
to the control device body 5 with the compensation signal 
prepared by the device 7. 
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Further, as shown in Fig. 2, in a tuning device for 
a robot control system in which a robot arm 4 with relatively 
low rigidity is caused to operate while driving actuator 
2 to a target value input to a control device body 5, the 
5 tuning device for the robot control system is characterized 
in that an external sensor 6A is provided, which detects 
overshoot amount at a direction changing point in 
reciprocating motion of the robot arm 4 from an external 
side; a control constant setting unit 9 is provided, which 

10 sets a control constant of a PID control system for forming 
the control device body 5 while* identifying a dynamic 
characteristic model of the robot arm 4; and a control 
constant fine adjusting unit 10 is provided, which fine 
adjusts the control constant set by the control constant 

15 setting unit 9 so that the overshoot amount falls within 
a prescribed value using a detection signal of the external 
sensor 6A when the robot arm 4 is caused to perform a 
reciprocating motion using a control constant set with the 
unit 9, 

20 (Operation) 

In tuning device TA of the robot control system of 
the present invention shown in Fig. 1, there is prepared 
a compensation signal for changing a target value so that 
the robot arm 4 operates just as the target value in relation 

25 to the target value input to the control device body 5 while 
identifying a dynamic characteristic model using an actual 
operation of the robot arm detected by the external sensor 
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6, and the target value is changed with a target value 
changing unit 8. 

Further, the tuning device TB of the robot control 
system shown in Fig. 2, there is set a control constant 
5 of a PID control system for forming the control device body 
5 while identifying the dynamic characteristic model using 
an operation detection signal of the actuator 2, and a 
reciprocating motion is provided to the robot arm 4 due 
to a set PID control constant, so that the PID control 
10 constant is fine adjusted based on overshoot amount 
detected by the external sensor 6A. 
(Embodiment ) 

Hereinafter, there will be described an embodiment 
of the present invention. 

15 Referring to Fig. 3, the tuning device TA1 as an 

embodiment of the tuning device TA shown in Fig. 1, in a 
control system composed of a PID control devise 5A, a motor 
2A, a motor angle sensor 1A, a reducer 3A, and a robot arm 
4, is constituted by attaching an external sensor 6 for 

20 detecting a point operation of the robot arm 4, a dynamic 
characteristic identification part 7A as a compensation 
signal preparing device 7, and a target value changing unit 
8 . 

The external sensor 6 constituted with an 
25 acceleration sensor, a non-contact displacement sensor, 
three-dimension coordinate measuring instrument and the 
like, detects a current angle of a point position of the 
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robot arm 4 in real time by observing the point position 
of the robot arm 4 during a tuning work. 

The dynamic characteristic identification part 7A, 
when performing the ident ification operation whi le sending 
5 a predetermined identifying signal with an identifying 
signal generator 9, obtains a frequency response in such 
a way that a motor angle 0 m detected by the motor angle 
sensor 1A and an arm angle 0 e detected by the external sensor 
6 are input with the switch 11 on A side, before fitting 
10 it to ARMA model by the least-squares method shown in the 
following reference documents 1), 2). Next, there is 
prepared a compensation signal which serves a target value 

9 mr toward a motor 2A as a target value 0 er toward the robot 
arm 4 input to a PID control device 5A, by obtaining a 
15 transfer function G(S) of continuous time using, for 
instance, "curved line adaptation" described in the 
following reference document 3) to the frequency response . 

1) " Two-degree-of-f reedom PID automatic tuning 
controller" by Shigemasa, lino, Kanda, Toshiba Review, Vol. 

20 42, Number 11, pp 822 to 826 (1987) 

2) "Signal processing and System identification" by 
Nakamizo, Takayoshi, Colona Company (1988) 

3) "Method for obtaining a transfer function by 
frequency response measuring value" by Yamashita, Suzuki, 

25 Fujii, Control Engineering, 14-11, pp 664 to 667 (1970) 
That is, the transfer function G(S) of this case is 
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e e D G S+K G w 

Here, since G(S) is obtained by 
M e is a moment of inertia of the arm; 
D e is viscous friction coefficient of the arm axis; 
K G is a spring constant of the reducer 3A; 
D G is twisting viscous friction coefficient of the 
reducer 3A; 

N is reduction ratio (> 1); and 
S is a Laplace operator. 

By this means, a compensation value A9 r is prepared 
in order to serve a motor target value 9 mr as an arm target 
value 0 me , and which compensation value A0 r is set to the 
target value changing unit 8, thus, the robot arm 4 is 
controlled in' low vibration and high positioning by the 
changed target value. 

Further, in the robot generally, since the moment 
of inertia M e of the arm in equation (1) changes according 
to an arm attitude or size of object to be grasped during 
operation, the robot is caused to have function to update 
a coefficient of S 2 of the target value changing unit 8 
in real time. For instance, in the case of a two-joint 
robot in which one more arm is coupled to the robot arm 
4 shown in Fig. 3, when letting an arm angle of the second 
joint be 0 e 2/ a motor angle be G m2 , the moment of inertia 
M e 2 around the first joint, because of sin 0 e2 « sin 0 m2 , 
is expressed by the following equation. 
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Me2 = M e - Msin 9 e 2 

« M e - Msin 9 m2 • • • (2) 
Here, M e is the moment of inertia by arranging the 
first and the second joints; and 
5 M is the moment of inertia around the second joint. 

Thus , when replacing the moment o f inertiaM e2 obtained 
with the equation (2) into the moment of inertia M e of the 
arm of the equation (1), it becomes possible to perform 
target value change corresponding to change of the arm 
10 attitude in real time. 

On the other hand, in order to perform the target 
value change corresponding to size of the object to be 
grasped, with a timing to grasp the object to be grasped, 

with AM e as a fluctuation part measured beforehand, while 
15 setting M e as follows: - - - 

M e <- (M e + AM e ) (3) 

The moment of inertia M e of the arm may be updated. 

Furthermore, even though there is changed the dynamic 
characteristics such as secular change of the robot arm 
20 4, the viscous friction coefficient D e of the arm axis, 
the spring constant K G of the reducer 3A, the twisting 
viscous friction coefficient DG of the reducer 3A and the 
like, the dynamic characteristic model identification part 
7A responds to identify it, thus it is possible to perform 
25 control preferably if updating an identification model used 
in the target value changing unit 8 . 

Fig. 4 is a graph showing time response according 
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to this embodiment as apparent when comparing with 
conventional example shown in Fig. 27 , the arm angle 9 e 
adequately follows a target arm angle 9 er - 

As described above, according to the present 
5 embodiment, the target value changing unit 8 changes the 

target motor angle 0 e into the target arm angle 0 m and serves 
its value as the target value of the control system based 
on the identification model obtained with the dynamic 
characteristic model identification part 7A, thereby 

10 vibration of the arm point is suppressed. Therefore, it 
is possible to achieve reduction of positioning time and 
improvement of positioning accuracy of the robot arm 4. 

Next, when referring to Fig. 5 as one embodiment of 
the tuning device TB of Fig. 2, in the tuning device TBI 

15 ofthepresent example, a motor 2 A is connected to a software 
servo part 5B as the control device body 5 via a switch 
11A, and the robot arm 4 is connected to the motor 2A via 
a joint member 3B . 

The software servo part 5B, as shown in Fig. 6, is 

20 constituted of a position loop part 14 provided with a feed 
forward (FF) control part 12 and a proportional (P) control 
part 13, a speed loop part 17 provided with an integral 
(I) control part 15 and a P control part 16, and a numerical 
value differentiating part 18, in which target values of 

25 position and speed V mr , 0 mr are input, and detected values 
&m, V m are fed back to the target values of position and 
speed V mr , 0 mr , so that output u is supplied to the motor 
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2A. 

An identifying signal generating part 9A is arranged 
in parallel to the software servo part 5B. The switch 11A 
switches to input a signal to the motor 2A, which signal 
5 is output from either the identifying signal generating 
part 9A connected to one terminal A side or the software 
servo part 5B connected to other terminal B side. 

An identifying signal MS is constituted by a 16-bit 
shift register 19 as shown in Fig. 7 and an operation part 
10 20 which takes in data of two registers among registers 

19 every sample time AT, and which outputs its exclusive 
OR to one end of the register 19. The identifying signal 
MS, then outputs M sequence signal MS as being 1, 0, 0, 
1, 1, 1..., shown in Fig. 8 with amplitude ±A from its output 
1 5 terminal . 

An input/output signal memory part 9B switches 
control constant setting time switches 11C, 11D from empty 
terminal B to one terminal A, inputs an input signal MS 

for the motor 2A and the motor angle 9 m detected by the 
20 motor angle sensor 1A, and registers to store it temporary. 

A dynamic characteristic model identification part 
9C identifies the dynamic characteristic model based on 
the data stored in the input/output signal memory part 9B . 
A control constant calculating part 9D sets the 
25 predetermined PID control constant to the software servo 
part 5B due to the identified dynamic characteristic model . 

Further, a non-contact displacement measuring unit 
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6A is arranged to the robot arm 4, which non-contact 
displacement measuring unit 6A is connected to a control 
constant fine adjusting part 10A via the switch HE. The 
switch HE outputs a detection signal X s to the control 
5 constant fine adjusting part 10A when switching one empty 
terminal A to the other terminal B. The measuring unit 
6A here reads displacement X g of a temporary stop position 
at the time of a change of direction when the robot arm 
4 is caused to perform reciprocating motion, 
10 The control constant fine adjusting part 10A further 

makes fine adjustment in relation to the control constant, 
which the control constant calculating part 9D has 
calculated once as will be described in detail with Fig. 
9. 

15 Fig. 9 is a flowchart showing tuning procedure of 

the tuning device TBI. 

As shown in drawing, when a tuning start command is 

output in STEP 901, each switch 11A, 11B, 11C, 11D, HE 

is tilted to one terminal A side in STEP 902. 
20 That is, in Fig. 5, the M sequence signal MS from 

the identifying signal generating part 9A is input to the 

motor 2A, and this signal MS and the motor angle 9 m detected 
by the motor angle sensor 1A are input to the input/output 
signal memory part 9B. 
25 Accordingly, in STEP 903, when the identifying signal 

generating part 9A generates the M sequence signal MSI of 
relatively large amplitude as shown in Fig. 11, a torque 
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is generated, which is accompanied with the generation of 
the M sequence signal MAI, so that the motor 2A results 
in excitation in STEP 904 as shown in Fig. 10. By the way, 
in Fig. 11, since it is not possible to illustrate a waveform 
5 of the minute M sequence signal MSI, only its amplitude 
is shown. 

STEP 905 illustrates that an input signal MSI and 

an output signal 0 m are registered in the input /output signal 
memory part 9B. 

10 Next, in STEP 906, the frequency response diagram 

shown in Fig. 12 is identified based on the data stored 
in the input/output signal memory 9B . The PID control 
constant is calculated, which produces good time response, 
and the PID control constant is set to the software servo 

15 part 5B. 

Next, in STEP 907, respective switches 11A to HE 
are tilted toward the terminal B side. In STEP 910, the 
reciprocating motion is suppl ied to the robot arm. In STEP 
911, a displacement signal of the point of the arm is 

20 collected. In STEP 912, a locus displacement signal X g 
of the point of the arm at the temporary stop position when 
turning around is measured, and whether this overshoot 
amount is in tolerance or not is investigated. The fine 
adjustment is carried out until the overshoot amount falls 

25 within the tolerance at STEPs 913, 908, and 909 when the 
overshoot amount is over the tolerance. 

In these processing, in the dynamic characteristic 
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model identification part 9C, the stored signal u and data 

example of V m (numerical differentiation of 0 m ) are 
performed fitting to the ARMA (Auto Regressive Moving 
Average) model due to the least-square method indicated 
5 in the above described reference documents; 

1) "Two-degree-of-f reedom PID automatic tuning 
controller " by Shigemasa, lino, Kanda, Toshiba Review, Vol. 
42, Number 11, pp 822 to 826 (1987) 

2) "Signal processing and System identification-" .by 
10 Nakamizo, Takayoshi, Colona Company (1988). 

Thus, there is obtained a pulse transfer function 
of the input/output (4) . 

Go ( z -.) = az-+-+».z- ... (4) 

Here, Z" 1 is a unit of time delay operator , if a sample 
15 time of the data is T, and an angular frequency is cd ( = 
2'7tf : f is frequency) , since there is a relationship of 
Z" 1 = e" jWT , G 0 (Z~ 1 ) results in the frequency response from 
the motor input u until the motor angular speed output V m , 

which Go ( j (D ) is obtained by substituting Z" 1 = e" jWT for G 0 ( Z" 1 ) , 
20 As for the order n, a numerical value is selected where 

there results in no change in frequency response as 

increasing the order n from lower one. 

Further, in the case of a robot operating against 

gravity such as a vertical poly-articulated robot, since 
2 5 non- linear gravity component is included in the identifying 

data, when applying the least-square method as it is, an 
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error occurs in the identified frequency response. 
Furthermore, even though a robot is a horizontal 
poly-articulated robot, non-linear frictional force such 
as Coulomb frictional force is included. Therefore, a 
5 dynamic equation of one-axis arm at low frequency of 0.1 
to 1Hz in which these non linear components operate largely 
is given as follows: 

m-a m + d-V m + F-sgn(V m ) + g-sin (0 m ) = U (5) 

Here, 0 m : motor rotation angle, 
10 u: input to the motor, 

V m : 1 time numerical differentiation of 0 m (motor 
angular speed) , 

a m : 2 times numerical differentiation of 0 m (motor 
angular acceleration) , 
15 m: moment of inertia, 

m-a m : inertia force term around axis, 
d: viscous frictional coefficient, 

d-V m : viscous frictional force term around axis, 
F: Coulomb frictional force, 

2 0 F-sgn ( V m ) : Coulomb frictional force term around axi s , 

g: gravity, 

g-sin (G m ) : gravity term around axis. 

When transforming the above equation, there is 
obtained an equation (6) as follows: 
25 [a m , V m , sgn (V m ) , sin (9 m ) ] [m, d, F, g] T = u ••• (6) 

Each signal of a m , V m , sgn (V m ) , sin (0 m ) , u of the 
present equation is the signal obtained in the input/output 
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memory part 9B, or the signal capable of being calculated 
therefrom, therefore, it is possible to find unknown m, 
d, F, g due to application of the least square method. In 
addition, the following equation is set as: 
5 u 2 = u - F-sgn (V m ) - g-sin (9 m ) (7) 

then, a value u 2 is found in such a way that the Coulomb 
frictional force component and a gravitational component 
are subtracted from a motor input u, and it is possible 
to separate the non-linear force when identifying the 
10 frequency response with the above described method while 
using the u 2 and V m . Further, compensation control of the 
Coulomb frictional force and gravity is capable of being 

performed if F-sgn (V m ) and g-sin (9 m ) are calculated during 
the software servo control using the obtained F, g, and 

15 adds F-sgn (V m ) and g*sin (9 m ) to the motor input. 

In the control constant calculating part 9D, based 
on the frequency response obtained in such a way as above, 
first, I-P control constant of a speed loop part 17 in Fig. 
6 of the software servo part 5B is calculated (Referring 

20 to the reference document 1), a reference document 4) 
described below) . 

4) "Control System Design Method based on Model 
Matching at Cut Off Frequency Band" by Shigemasa, lino, 
the 29th Automatic Control United Lecture Meeting Drafts 

25 Collection, pp 15 to 18 (1986) . 

The I-P control constant is calculated so as to satisfy 
an index (phase margin and gain margin shown in Fig. 17) 
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of a control system stability specified by the speed loop 
part 17 based on the above reference documents 1) , and 4) . 

Here, the phase margin represents how many degree 

of margin until a phase arrives at 180° in the frequency 
5 when the gain of an open-loop frequency response of the 
speed loop becomes OdB (so called as cut off frequency) . 
The open-loop frequency response is a frequency response 
from one end to the other end when cutting a loop at the 
point of control deviation (difference between target value 

10 and control amount: immediately front of an integral 

constant I in the speed loop) . Further, the gain margin 
represents how many decibel of margin until a gain arrives 
at OdB in the frequency when the phase of the open-loop 
frequency response of the speed loop becomes 180°. 

15 By the way, generally, the larger the phase margin, 

and the gain margin, the more the control system is stable, 
however, quick-response property toward the target value 
becomes poor. In the general servo control system, it is 

appropriate that the phase margin is 50 to 70°, and the 
20 gain margin is 12 to 20dB. 

On the other hand, in the robot, it is necessary to 

cope with both the quick-response property and the 

overshoot (the smaller the better) of the time response. 

Accordingly, a speed I-P control gain is calculated with 
25 a repeat calculation so as to make matching to Bessel Model 

(gain margin: 15.6dB, phase margin: 67.2°) of reference 
models performing time response as shown in Fig. 16. Fig. 
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17 shows the speed I-P loop of open-loop frequency response 
at this time. In this example, when I is 769, and P is 
15.3, the specified gain margin and phase margin are 
satisfied . 

■5 Next, P control constant of a position loop part 14 

in Fig. 6 is calculated. Here, the P control constant is 
calculated, which is made 2tc/3 of the cut off frequency 
of the speed loop shown in Fig. 17 so as to be obtained 
appropriate time response to a motor angle target value. 

10 Since the cut off frequency is 6.8Hz, P is calculated as 
14.2. A feed forward control constant FF is introduced 
so as to enhance the quick-response property within a scope 
which does not increase the overshoot of the time response, 
thus the feed forward control constant FF is set to 0.3. 

15 In the software servo part 5D, when a change-over 

switch is B, the speed loop I-P, and the position loop FF-P 
are controlled and operated, and the robot arm 4 is 
controlled upon causing to follow the motor 2A to a 
rotational angle target value 0 r . By the way, since a motor 

20 angular speed target value V mr used for FF turns up in a 
course where the motor angle target value is created, thus 
it is not necessary to differentiate the angle target value 

9mr over again. 

In the control constant fine adjusting part 10A, the 
25 displacement signal X g of the point of arm of the robot 
which is in control from the non-contact displacement 
measuring unit 6A is taken in when the change-over switch 
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is B, and as shown in Fig. 18, the I-P control constant 
of the speed loop part 14 is performed fine adjustment so 
that the overshoot of the arm from the target stop position 

is included in tolerance value 8. A method of fine 
5 adjustment is that the gain margin specified at the time 
of the speed loop I-P control constant calculation is 
increased gradually, and it is preferable to adopt the I-P 
control constant at the time the overshoot amount is entered 

in the tolerance value 8, 

10 By the way, in order to remove a non- tracking component 

caused by static friction or the like of the robot arm 4, 
amplitude of the M sequence signal MSI shown in Fig. 10 
should be made large significantly. Further, even though 
it is made large significantly, whether influence caused 

15 by the static friction isremoved sufficiently or not is 
the problem. 

Accordingly, in the present example, further as shown 
in Fig. 14, DC bias DB is supplied to the original M sequence 
signal MS, as shown in Fig. 13, the robot arm 4 is caused 

20 to excite while letting the robot arm 4 slip. 

Fig. 15 is a frequency response diagram in the case 
that the DC bias DB is supplied. It is understood that 
the frequency response of the low frequency is obtained 
appropriately compared with the one in Fig. 12. 

25 As described above, according to the tuning device 

TBI for the robot control systemof the present example, 
it is possible to set the PID control constant easily, surely, 
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quickly and in an appropriate time by inputting the M 

sequence signal MS to the motor 2A. 

Further, in the case that a signal MS 2 formed in such 

a way as to supply the DC bias DB to the M sequence signal 
5 MS is used, it is possible to supply the control constant 

with appropriate matching regardless of the low frequency. 

Furthermore, since the fine adjusting part 10A is 

caused to be attached, it is possible to suppress the 

overshoot amount within the tolerance, thus the robot arm 
10 4 is capable of being positioned with low vibration, and 

high accuracy. 

In the embodiment shown above, there is described 

an automatic tuning for one axis of the robot, however, 

it is possible to perform the tuning procedure for each 
15 axis of the case of multiple axes in the same method as 

that described above. That is, in the case of a multi axes 

robot in which the arms are ranged continuously, if 

algorithm is built in the robot, which algorithm operates 

from an axis close to a stand of the robot sequentially, 
20 it is possible to prevent from changing tuning result of 

the axis close to the finger caused by the tuning result 

of the axis close to the stand. 

For instance, in the case that the robot of continuing 

two arms, first, tuning of one axis is performed. At this 
25 time, the second axis is in the state of servo free (without 

control) . Next, tuning of the second axis is performed. 

At this time, the first axis is made servo lock with already 
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tuned control constant . With this knack, even though more 
than three arms are continued, it is possible to perform 
appropriate tuning . 

Fig. 19 shows another constitution example of the 
5 software servo part. 

That is, the software servo part 5C of the present 
example, in order to control the objective robot arm 4, 
there are provided the PID control part 21 of the speed 
loop in the inside, and the PID control part 22 of the 
10 position loop at external side, which the software servo 
part 5C is constituted with multiple loop such that the 

inputs/outputs of 0d/ e, 9^ f e, u, ^ 9 in the drawing are 
performed. Then, the control constants of the two PID 
control parts 21 and 22 are set to the appropriate values 
15 depending on characteristics of the objective robot arm 
4 . 

First, in the general operation method, the frequency 
characteristic of the motor 2A relating to an input u and 

an output 0 in Fig. 19 is measured as shown in Fig. 20, 
20 and this is approximated upon determining a 0 to b 5/ b 0 to 
b 4 of the transfer function G (S) depending on the following 
equation as shown in Fig. 21. 

G(S) = A 2 /Ai (8) 
Provided, when Ai and A 2 are 
25 Ai = ao+aiS + a 2 S 2 + a3S 3 +a 4 S 4 + a 5 S 5 

A 2 = b 0 +biS + b 2 S 2 +b3S 3 +b 4 S 4 , 
the open- loop frequency characteristic G v (jco)of the speed 
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loop relating to the input e and the output 9 in Fig* 19 
is that, in 

Gvi(S) = (Co/S + C 1 )G(S) = (C 0 /S + Ci) (A 2 /Ai) • • • (9) , 
S is made S = jco. Provided, 
5 o = 27tf (j is imaginary unit , co is angular frequency, 

f is frequency) . 

The closed-loop frequency characteristic G vc {jco) of 

the speed loop relating to the input e and the output 6 
in- Fig. 19 is that, in 

10 Gvc ( S ) =Gvi ( S ) / ( 1 + Gvi ( S ) ) = * C ffi/?) 

• • • (10) , 

S is made S = j co . 

The op en- loop frequency characteristic G P i ( jco) of the 
position loop relating to the input e and the output 9 in 
15 Fig. 19 is obtained in such a way that S is made S = jco in 
Gpi (S) = (D 0 /D+S!)G V c(S) (1/S) 
= (Do/S + Di) Gvc(S) 

_ (D 0 /S + D 1 XC 0 /S + CjA 2 /A l ) (u) 
(l + (C 0 /S + CjA 2 /A i )) K ) 

while using the closed-loop frequency characteristic 
20 Gvc (jco) of the speed loop shown in Fig. 22. 

The closed-loop frequency characteristic G PC (jco) of 
the position loop relating to the input 0 O and the output 
8 in Fig. 19 is obtained in such a way that S is made S 
= j co in 

2 5 Gp C (S)=G P1 (S) / (1 + Gpi (S) )=A 4 /A 3 • • • (12) . 
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Provided, 

(i+(c 0 /s + cXa 2 /a,)) 

= u (D 0 /S + D l XC 0 /S + C l \A 2 /A l ) 

(i+(c 0 /5+c,X^/4)) 

However, in the general operation method, when 
determining the above described control constant, since 
5 characteristics of the robot are applied to the transfer 
function to represent it with parametric data, and the 
frequency characteristics of respective loops are found 
by the algebraic operation using it, in the case of the 
control system constituted by multiple loop, the more the 
10 loop exists in the outside, the higher the order of the 
algebraic expression is, thus calculation becomes 
complicated, so that determination of the control constant 
is difficult, and further, there is a defect that errors 
are included at the time characteristics of the robot are 
15 applied to the algebraic expression. 

Accordingly, next, more appropriate operation method 
concerned with the software servo part 5c of such multiple 
loop will be described. 

As shown inSTEP2301 in Fig. 23, in the present example, 
20 operation is started from a taking in work of the 
characteristic data of the robot. 

That is, in STEP 2301, inputs of various frequencies 
f such as the above described M sequence signal MS are 
supplied to the robot arm 4 (motor 2A) shown in Fig. 5, 
25 then, in STEP 2302, gain characteristic data T G and phase 
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characteristic data T P shown in Fig. 24 are obtained. 

Accordingly, the frequency characteristics G ( j © ) of 
the robot arm 4 relating to the input u and the output 

9 in Fig. 19, byusing the both data T G and T P , is represented 
5 as 

G(jco) = T G »cosT P + j«T G *sinT P ---(13) 
Therefore, the open-loop frequency characteristic 

G V i(jco)of the speed loop relating to the input e and the 

output 8 in Fig. 19 becomes as follows: 
10 Gvi(jco) = ( (Co/jo) +Ci) G (jo) = 

(Co/ ( j»27Cf )+Ci) (TiCOsTp+j«T G sinT P ) • • • (14) 

Thus, when a real part of this equation is taken to 

as Ryfcyjija?)) , and an imaginary part is taken to as ^ m (G w (/<2>)) , 

gain characteristic data T G vi and phase characteristic data 
15 Tpvi of the open-loop frequency characteristics of the- speed 

loop can be calculated with 

Ton = Ma U*W + (Gw OF ...(15) 
T m =-tan- 1 (/ m (G w 0'^))/^(G H 0^))) 

Further, the closed-loop frequency characteristic 
G V c(jco)of the speed loop relating to the input e and the 
20 output 0 in Fig. 19 becomes as follows: 

G vc Q) = G„ Q)/(l + G„ {jo)) = ^ f C ' Xfe COS T " + > T ° sin T » > . ...(i 6 ) 

vc\J ) n\J M n\J n 1 + (C 0 l{jl7if ) + C, )(T a cos T p + jT G sin T p ) V ' 

a real part thereof is taken to as R e ( G V c ( j co ) ) , and an 
imaginary part thereof is taken to as I m ( G V c ( j co ) ) , gain 
25 characteristic data T G vc and phase characteristic data T PV c 
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of the closed-loop frequency characteristics of the speed 
loop can be calculated with: 

T PVC = tan" 1 (/ m (G yc {ja>j)I RXG VC (>))) 

Above described calculation processing is performed 
5 repeatedly until sufficient control constant is obtained 
at STEP 2307 while performing a frequency characteristic 
indication and a time response simulation based on the data 
obtained due to STEP 2303 to 2306. 

Next, in the case that a tuning of the position loop 
10 is performed via STEP 2308, processing proceeds to STEP 
2309, the same procedure is repeated where the input data 
is changed to the closed- loop frequency characteristic data 
of the speed loop. 

That is, since the open-loop frequency 
15 characteristic Gpi(jo) of the position loop relating to 
the input e and the output 0 in Fig. 19 becomes as follows: 

Gpi(jo) = (Do+Dijco) • (Gvc (jo) / (jo) ) = 
(D 0 / ( jo) +Di) Gvc ( jo) • • ■ (18) 

thus, by using the equation obtaining gain characteristic 
20 data T GV i and phase characteristic data T PV i of the open-loop 
frequency characteristics of the speed loop as it is, it 
is possible to find the gain characteristic data T G pi and 
position characteristic data Tppi of the open-loop frequency 
characteristics of the position loop from the gain 
25 characteristic data T G vc and the phase characteristic data 
Tpcv of the closed-loop frequency characteristic of the 
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speed loop shown in Fig. 21 . That is, provided that, C 0 ^D 0 , 
Ci-»Di, T G -^T G vc, Tp-^Tpvc/ in the equation (14), the open-loop 
frequency characteristics G P i(jG))of the position loop is 
found. Further, like the equation (15), there are found 
5 the gain characteristic data T G pi and the frequency 
characteristic data T PP i. 

Furthermore, also the closed-loop frequency 
characteristic G PC ( jco) of the position loop relating to the 
input 0 O and the output 0 in Fig. 19 can be calculated, 

10 provided that, C 0 ^D 0 , Ci-»Di, T G ^T GV c, T P ^T PV c, in the 

equation (16) , with the same equation as the equation (17) , 
there are found the gain characteristic data T GPC and the 
frequency characteristic data T PPC . 

In the present example, even though the control system 

15 is one which is constituted with such multiple i oops , since 
it is possible to calculate the whole numerically due to 
low order of equation while using the gain characteristic 
data and the phase characteristic data of the inside loop, 
the calculation is easy and there is a little error. 

20 As mentioned above, in short, in the general operation 

method, characteristics of the multiple loops are found 
with a shape of composition g-f (x) of approximate function 
f(x) (corresponding to equation (8)) and function g(x) 
representing the frequency characteristics of the 

25 respective loops, thus algebraic operation of a high order 
is forced. To the contrary, in the present example, f (x) 
is made data-oriented mode, and g-f (x) is calculated 
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numerically relative to the respective data, thereby 
operation is performed easily, and there becomes a little 
error . 

The present invention is not limited to the above 
5 mentioned embodiments, but the present invention can be 
executed with the appropriate mode in addition to the above 
by performing appropriate design change. 
[Effect of the Invention] 

As above, according to the present invention, since 

10 the target value input to the control device body is changed 
to one concerned with the point of the robot arm, by detecting 
point operation of the robot arm while providing the 
external sensor, it is possible to cause the high accurate 
positioning control to perform while suppressing vibration 

15 of the point of the robot arm. 

Further, since the external sensor is provided, which 
detects the overshoot amount at the motion changing point 
at the time the point of the robot arm is performed 
reciprocating motion, and the control constant set once 

20 is evaluated to adjust, which the control constant is set 
so that the overshoot amount enters within the 
predetermined value, it is possible to suppress the 
overshoot amount within the constant value according to 
secular change or fluctuation of the load constantly, thus 

25 it is possible to perform the positioning control of the 
robot arm in high accuracy. 

Furthermore, in the case that DC bias is applied to 



29 



the identifying signal on the occasion of the dynamic 
characteristic identification, since it is possible to 
excite the robot arm while sliding the robot arm, the high 
accuracy control constant is capable of being set while 
5 avoiding influence' caused by the static friction. 

Moreover, in the PID control device in which the 
position loop and the speed loop are constituted in multiple 
modes, when setting and evaluating the control constant, 
in the speed loop, the open-loop frequency characteristic 

10 data and the closed-loop frequency characteristic data of 
the speed loop are obtained while using the frequency 
characteristic data of single substance of the robot. In 
the case that the open-loop frequency characteristic data 
and the closed-loop frequency data of the position loop 

15 while using the closed-loop frequency characteristic data 
of the speed loop in the position loop, it is not necessary 
to perform high order of the operation using approximate 
expression, and it is possible to set more appropriate 
control constant with easy operation and high accuracy. 

20 4. Brief description of the Drawings 

Figs. 1 and 2 are block diagrams showing outline of 
the present invention. Fig. 3 is a block diagram showing 
a tuning device for a robot control system according to 
one embodiment of the invention shown in Fig. 1. Fig. 4 

25 is a graph showing its response performance. Fig. 5 is 
a block diagram showing the tuning device for the robot 
control system according to one embodiment of the invention 
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shown in Fig. 2. Fig. 6 is a block diagram showing one 
example of a detailed software servo part. Fig. 7 is a 
circuit diag ram showing a generating method of M sequence 
signal. Fig. 8 is a time chart of the M sequence signal 
5 generated by a circuit shown in Fig . 7. Fig. 9 is a flowchart 
of an automatic tuning system. Fig. 10 is a graph showing 
an output signal due to angular speed. Fig. 11 is a graph 
showing M sequence input signal due to a torque. Fig. 12 
is a frequency response diagram obtained by relationship 

10 between Fig. 10 and Fig. 11. Fig. 13 is a graph showing 
an output signal in the case of applying DC bias to the 
M sequence signal. Fig. 14 is a graph showing the M sequence 
signal to which DC bias is applied. Fig. 15 is a frequency 
response diagram obtained by relationship between Fig. 13 

15 and Fig. 14. Fig." 16 is a response diagram of various 
reference models . Fig . 17 is a graph showing a phase margin 
and a gain margin due to the frequency response diagram. 
Fig. 18 is an explanatory diagram showing tuning system 
of an overshoot. Fig. 19 is a block diagram showing one 

20 example of software servo part constituted by multiple loop 
Fig. 20 is a graph showing frequency characteristics with 
respect to the software servo part. Fig. 21 is a frequency 
characteristic diagram approximating the frequency 
characteristics. Fig. 22 is a closed-loop frequency 

25 characteristic diagram of a speed loop. Fig. 23 is a 
flowchart showing an operation method of a control constant 
to the software servo part constituted by the multiple loop . 
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Figs. 2 4 and 25 are explanatory diagrams of a gain 
characteristic data and a phase characteristic data used 
for an operation of Fig. 23. Fig. 26 is an explanatory 
diagram of a conventional robot control system. Fig. 27 
5 is a response graph after conventional control constant 
adj ustment . 
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3 Torque Transmission Mechanism 
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5 Control Device Body 

6 External Sensor 
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8 Target Value Changing Unit 

15 9 Control Constant Setting Unit 

10 Control Constant Fine Adjusting Unit 
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FIG. 1 
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FIG . 2 

1 ACTUATOR SENSOR 

2 ACTUATOR 

4 ROBOT ARM 

15 5 CONTROL DEVICE BODY 
6A EXTERNAL .SENSOR 

9 CONTROL CONSTANT SETTING UNIT 

10 CONTROL CONSTANT FINE ADJUSTING UNIT 

20 FIG. 3 

1A MOTOR ANGLE SENSOR 

2A MOTOR 

3A REDUCER 

4 ROBOT ARM 
25 5A PID CONTROL DEVICE 

6 EXTERNAL SENSOR 

7A DYNAMIC CHARACTERISTICS IDENTIFICATION PART 



33 



8 TARGET VALUE CHANGING UNIT 

9 IDENTIFYING SIGNAL GENERATOR 

FIG . 4 
5 ANGLE 
TIME T 

FIG. 5 
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FIG. 7 
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